home *** CD-ROM | disk | FTP | other *** search
/ Graphics Plus / Graphics Plus.iso / general / modelers / geomview / source.lha / Geomview / src / lib / geometry / transform3 / tm3invert.c < prev    next >
Encoding:
C/C++ Source or Header  |  1992-07-18  |  1.9 KB  |  75 lines
  1. /* Copyright (c) 1992 The Geometry Center; University of Minnesota
  2.    1300 South Second Street;  Minneapolis, MN  55454, USA;
  3.    
  4. This file is part of geomview/OOGL. geomview/OOGL is free software;
  5. you can redistribute it and/or modify it only under the terms given in
  6. the file COPYING, which you should have received along with this file.
  7. This and other related software may be obtained via anonymous ftp from
  8. geom.umn.edu; email: software@geom.umn.edu. */
  9.  
  10. /* Authors: Charlie Gunn, Pat Hanrahan, Stuart Levy, Tamara Munzner, Mark Phillips */
  11.  
  12. #include "transform3.h"
  13.  
  14.  
  15. /*-----------------------------------------------------------------------
  16.  * Function:    Tm3Invert
  17.  * Description:    compute the inverse of a Transform
  18.  * Args:    m: the transform (INPUT)
  19.  *        mi: the inverse transform (OUTPUT)
  20.  * Returns:    nothing
  21.  * Author:    njt
  22.  * Date:    Sat Jul 18 12:04:19 CDT 1992
  23.  */
  24. float
  25. Tm3Invert(m, mi)
  26. Transform3 m, mi;
  27. {
  28.     register int i, j;
  29.     register int k;
  30.     float x;
  31.     Transform3 t;
  32.     float f;
  33.     Tm3Copy(m, t);
  34.     Tm3Copy(TM3_IDENTITY, mi);
  35.  
  36.     /* Components of unrolled inner loops: */
  37. #define    SUB(v,k)  v[j][k] -= f*v[i][k]
  38. #define    SWAP(v,k) x = v[i][k], v[i][k] = v[largest][k], v[largest][k] = x
  39.  
  40.  
  41.     for (i = 0; i < 4; i++) {
  42.         int largest = i;
  43.         float largesq = t[i][i]*t[i][i];
  44.         for (j = i+1; j < 4; j++)
  45.             if ((x = t[j][i]*t[j][i]) > largesq)
  46.                 largest = j,  largesq = x;
  47.  
  48.         /* swap t[i][] with t[largest][] */
  49.         SWAP(t,0);  SWAP(t,1);  SWAP(t,2);  SWAP(t,3);
  50.         SWAP(mi,0); SWAP(mi,1); SWAP(mi,2); SWAP(mi,3);
  51.  
  52.         for (j = i+1; j < 4; j++) {
  53.             f = t[j][i] / t[i][i];
  54.             /* subtract f*t[i][] from t[j][] */
  55.             SUB(t,0); SUB(t,1); SUB(t,2); SUB(t,3);
  56.             SUB(mi,0); SUB(mi,1); SUB(mi,2); SUB(mi,3);
  57.         }
  58.     }
  59.     for (i = 0; i < 4; i++) {
  60.         f = t[i][i];
  61.         for (k = 0; k < 4; k++) {
  62.             t[i][k] /= f;
  63.             mi[i][k] /= f;
  64.         }
  65.     }
  66.     for (i = 3; i >= 0; i--)
  67.         for (j = i-1; j >= 0; j--) {
  68.             f = t[j][i];
  69.             SUB(t,0); SUB(t,1); SUB(t,2); SUB(t,3);
  70.             SUB(mi,0); SUB(mi,1); SUB(mi,2); SUB(mi,3);
  71.         }
  72.                 
  73.     return 1;
  74. }
  75.